VEHICLE COLLISION AVOIDANCE SYSTEM AND METHOD 

BACKGROUND OF THE INVENTION 

5 [001] The present invention generally relates to vehicle collision avoidance systems 

and methods and more particularly to a vehicle collision avoidance system and method 
employing a rotating pulsed infrared laser beam scanner apparatus for detecting obstacles 
circumferentially of the vehicle. 

[002] Vehicle collision avoidance systems and methods are well known in the art. 

10 For example, U.S. Patent No. 4,825,211, "Warning Device for Vehicles Against an 
Approaching Objects" discloses a warning device for use on a vehicle for sensing an 
approaching o bject when the vehicle is moving backwards. The device produces a first 
signal when the object is in remote proximity of the vehicle and at least a second signal 
when the object is in close proximity of the vehicle. 

15 [003] U.S. Patent No. 4,872,051, "Collision Avoidance Alarm System" discloses a 

passive collision avoidance system. An optical sensor is disposed to provide a continuous 
raster scan of the scene within a wide angle of the direction of travel of the vehicle. This 
sensor output is converted into digital data and stored. A computer system compares 
consecutive scenes to detect identifiable objects. For such identifiable objects, the 

20 computer calculates the centroid of the object and its angle, and a measure of the size or 
extent of the object. Detection of an object having a constant angle and an increasing 
measure of extent causes an alarm to be triggered. 

[004] U.S. Patent No. 5,314,037 "Automobile Collision Avoidance System" 

discloses a system based on laser radars for aiding in avoidance of automobile collisions. 

25 The system includes laser radars with transmitters and receivers, a computer, a warning 
device and an optional automatic braking device. The system compares a predicted 
collision time with a minimal allowable time to determine the immanency of a collision. 
When the system determines that a situation likely to result in an accident exists, it provides 
a warning. The optional automatic braking device is used when the vehicle user fails to 

30 respond to the warning. 

[005] U.S. Patent No. 5,410,304 "Method and Apparatus for Displaying the 

Impending Danger Due to Speed Associated with the Driving Situation of a Vehicle" 
discloses a method in accordance with which a degree of danger is defined and calculated 
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and displayed to the driver of a vehicle, the degrees of danger indicating whether the driver 
of the vehicle is driving too close to a vehicle in front or other obstacle or is driving too fast 
in a fog. The signals necessary for this purpose are obtained from vehicle environment 
sensors, for example from a distance warning radar or distance recording radar and an 
5 infrared visual range measuring system, and are analyzed, together with vehicle condition 
signals, by a safety computer. On the basis of its specific programming, the computer 
determines, for the respective current driving condition, which of two degrees of danger is 
instantaneously predominant and indicates the condition which is respectively more critical 
to safety on a display. 

10 [006] U.S. Patent No. 5,463,384 "Collision Avoidance System for Vehicles" 

discloses a system including an object detection module mounted on a vehicle for detecting 
the presence of an object within a monitored zone of space adjacent the vehicle. The 
detection u nit e mits a plurality of beams of infrared energy and detects the reflection of 
such energy from objects within the zone. The detection module is typically activated by 

15 the host vehicle's electrical turn signal. The detection module includes a plurality of 
associated pairs of light emitting diodes and photosensitive detectors for sensing the 
reflected light. 

[007] U.S. Patent No. 5,646,612 "Method for Avoiding Collision of Vehicle and 

Apparatus for Performing the Same" discloses an apparatus which determines a kind of an 
20 object ahead of a vehicle to warn a driver based on the kind of the object and properly 
performs deceleration and braking operations based on a position of the object and a 
speed of the vehicle. 

[008] U.S. Patent No. 6,012,008 "Method and Apparatus for Predicting a Crash and 

Reacting Thereto" discloses an apparatus which is mounted on a vehicle and determines 
25 the time-to-impact for approaching obstacles that are within a limited distance from the host 
vehicle. The system can be deployed in the front of the host vehicle for warning of frontal 
impact, and at the sides for warning of side impact. 

[009] U.S. Patent No. 6,470,273 "Collision Warning System" discloses a system 

including pairs of optical sensors integral to a moving vehicle. Each of the optical sensors 
30 of the pairs of said sensors is enabled for the detection of visible light magnitudes and 
infrared light magnitudes in the external vicinity of the vehicle, and for creating 
corresponding electrical signals. The optical sensors are directed in a physically spaced 
apart manner along a line of travel of the vehicle. Temporal changes in the magnitudes of 


the electrical signals and a probability of a collision with an object external to the vehicle 
are determined and a warning signal is generated when collision is possible. 
[010] As can be seen, the prior art discloses systems and methods for sensing 

objects and potential collisions within narrow ranges, generally in the direction of vehicle 
5 travel or to cover "blind spots", and as such there is a need for a vehicle collision avoidance 
system and method employing a rotating pulsed infrared laser beam scanner apparatus for 
detecting obstacles circumferentially of the vehicle. 

SUMMARY OF THE INVENTION 

10 

[011] In accordance with one aspect of the invention, a vehicle collision avoidance 

system includes a rotating pulsed infrared laser beam scanner apparatus for generating a 
first signal representative of an obstacle; a processing circuit coupled to the rotating pulsed 
infrared laser beam scanner apparatus for processing the first signal and generating a 
15 plurality of signals; a processor coupled to the processing circuit for processing the plurality 
of signals and generating a braking signal; and a braking apparatus responsive to the 
braking signal. 

[012] In accordance with another aspect of the invention, a method of avoiding a 

vehicle collision includes determining features of an obstacle using a rotating pulsed 
20 infrared laser beam scanner apparatus; processing signals representative of the 
determined features; and braking the vehicle in the event the processed signals indicate an 
imminent collision. 

[013] These and other features, aspects and advantages of the present invention 

will become better understood with reference to the following drawings, description and 
25 claims. 

BRIEF DESCRIPTION OF THE DRAWINGS 

[014] FIG. 1 is an isometric view of a vehicle having mounted thereon a rotating 

30 pulsed infrared laser beam scanner apparatus in accordance with the present invention; 
[015] FIG. 2 is a schematic view showing a sector in accordance with the present 

invention; 
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[016] FIG. 2A is a schematic view of an infrared laser beam in accordance with the 

present invention; 

[017] FIG. 3 is a block diagram of a method of avoiding vehicle collisions in 

accordance with the present invention; 
5 [018] FIG. 4 is a circuit diagram of a an analog circuit in accordance with the 

present invention; 

[019] FIG. 5 is a listing showing an algorithm in accordance with the present 

invention; 

[020] FIG. 6 is a schematic diagram of a coordinate system in accordance with the 

10 present invention; 

[021] FIG. 7 is a schematic diagram of a coordinate system in accordance with the 

present invention; and 

[022] FIG. 8 is a schematic diagram of a coordinate system in accordance with the 

present invention. 

15 DETAILED DESCRIPTION OF THE INVENTION 

[023] The following detailed description is of the best modes of carrying out the 

invention. The description is not to be taken in a limiting sense, but is made merely for the 
purpose of illustrating the general principles of the invention, since the scope of the 
20 invention is best defined by the appended claims. 

[024] The present invention generally provides a vehicle collision avoidance system 

and method employing a rotating pulsed infrared laser beam scanner apparatus for 
detecting obstacles circumferentially of the vehicle. 

[025] With reference to FIG. 1, a system in accordance with the invention includes 

25 a rotating pulsed infrared laser beam scanner apparatus 100 mounted on a top 110 of a 
vehicle 120 for transmitting and receiving an infrared laser beam having properties as 
further described in Table 1. Advantageously, the rotating scanner apparatus 100 includes 
both horizontal and vertical scanning capabilities. More specifically, the rotating scanner 
apparatus 100 rotates in a horizontal plane at 48 revolutions per second and in a vertical 
30 plane at 8 sectors per second. A sector 200 is shown in FIG. 2 and may include an angle a 
of 2.5 degrees with the sectors ranging from 28.8 degrees to 88.8 degrees. 
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Optics Properties 


Transmitter 


Wavelength 
Range 


Peak Power 


Typical 

Repetition 
Rate 


Modulating 
(For ranging 
purpose) 


Sensitivity 


Power 
Density at 
the cornea 


Channels 


Frequency 


1, OOOnm to 1, 
550nm, excludes 
1,300 to 1,400nm. 


Pt (peak, max) = 
28.45 W 

Pt (Ave.)= 104 mW 


Repetition Rate frr: 
10Mhz to 110Mhz 

Pulse width T 
(constant):1.0ns 

(25% tolerance) 


Exp (-9) W 


0.530 mw/sqcm 


1,000 


833.33khz 


Physical Properties 


Divergent 
***Angle 


Diameter of 
the lens in 


Target 


a = 0.00212206 rad 
= 0.763942° 


10 -20cm 


D1 = 50mm 


D2 =18cm, 


Horizontal 

Hosting 
disk 

Period 

Rotation Speed 

20.83 
ms 

RPS = 48 

Longitudi- 

Sector 

125ms 

SPS = 8 

nal 

(in the 


(Here SPS stands 


disk 


for "Sectors Per 


hosted 


Second") 


to the 




hosting 




disk) 




Scanner 
body at 
Vertical 
Section 


Scanner 
body 

diameter at 

Horizontal 

Section 


Not greater than 2.5cm 


Not greater than 2.5 cm 


Table 1 Specification of Pulsed Infrared Laser 


[026] Referring to FIG. 2 A, the scanning power P t of the rotating pulsed i nfrared 

laser beam scanner apparatus 100 may be computed using a reflected area (half sphere) 
Sr of 2 Pi R**2 and a lens diameter of Dl = 50mm. Then the efficiency r) T 
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= rjrf * [(st'/st) * (sl/sr)] 

(D 

= 0.25 * [(7xRt ,2 /7iRt 2 )*(7iRI 2 12% R 2 )] 

(2) 

= [(Dt' 2 /Dt 2 )*(DI 2 /(Dr) 2 ] * 0.25 * 1/2 

(3) 

= .125 [(Dl/Dr)]**2 

(4) 

= .125 ((5/18) (18/ 18, 000))**2 

(5) 

= 9.65Exp(-9) 

(6) 

Pt-r)T=PRE 

(7) 

Pt >io- 9 w 

(8) 

Pt ( p e ak) £ 10" 9 /9.65Exp(-9) 

(9) 

= 0.104 W 

(10) 

= 104 mw 

(11) 


where Qrf: is the reflection rate - the ratio of reflected power (or energy) over insertion 
power (or energy), Rt is the area on the target intercept with the laser beam, Rt' is the 
minimum detectable as design required on the object, and R is the distance to an object 
15 130 (FIG. 1) from the rotating pulsed infrared laser beam scanner apparatus 100. 
Considering modulation factor 1/100 (carrier purpose) & 0.5 (for ranging purpose, it 
becomes 

Pt (Average) = 104/200 (12) 

= 0.520 mW (13). 

20 [027] To have 40db (100times of power factor) reserved power capacity to cope 

with foggy/rainy or dirty targets, it may be necessary to raise the transmitted power 
potential into a maximum value 

Pt (Max) = 0.104* 100 (14) 

= 10.4W (15) 

25 Pt (max, Average) = .52 *1 00 (1 6) 

= 52 mw (17). 


6 


Power of average level, at the cornea after counting the duration when the cornea truly 


receives the laser beam may be calculated as 

P( RE, average, cornea) = Prac (18) 

= 52 mw*R* 9/2Pi*R (19) 

5 = 52*0.002/2Pi (20) 

= 52/3125 (21) 

= 0.0166(mw) (22) 


where P RE is the receiving power on the sensor and P t : is the transmitting power from 
transmitter. 

10 [028] From the above computations several conclusions can be obtained. A first 

conclusion is that the ideal peak transmit power Pt (peak, Res) of the pulsed laser able to 
deal with reserved potential for a worst condition, may at least be 12.2 W or P (peak, Res) 
> 10.4 w. A second conclusion is that the basic power requirement (without reserved 
capacity) may be Pt (peak, basic) = 104 mw. A third conclusion is that the average 

15 maximum received power (counting in the object occupation at the circumference factor) 
may be Pre (AVE) = 0.0166 mw. Finally, a fourth conclusion is that the power density on 
the cornea may be Pre (density) = Pt (AVE)*S(cornea)/S(target))/S(cornea) 


= Prac / S ( target ) (23) 

=0.0166mw/Pi*Rt**2 (24) 

20 ' =0.0166mw/3.14*(Rt(min)* 0.0002)**2 (25) 

= 0.0166mw/3.14 (50*0.002)**2 (26) 

= 0.0166mw/0.0314Sqcm (27) 

= 0.530 mw/Sqcm (28) 


where St is an area on the target - a cross section formed at certain distance away from the 
25 laser source where the propagating laser beam is cut by the target body, Rt is the distance 
from the laser source to the surface denoted as St, Rt (min) is the minimum distance of Rt 
determined by the real situation, here taken to be 50cm for safety purposes. 

[029] To determine if the pulsed laser beam of the invention is safe in its application in 

terms OF IEC regulations, the following three computations can be performed. (1) MPE 
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(single) requirement: Compute the MPE for a single pulse at wave length of 1030 - 1050nm, 
1ns to 100ns (Exp(-9)s to Exp(-7)s pulse width range with pulse duration shorter than 1ms 
yielding EMP (Single) = 5Exp(-3) C4C6J/sqm = 0.005x5x1.33/10,000 = 3.3Exp (-6) J/sq cm. 
(2) Since the pulsed laser series is designed to be uniform, thus it meets the item B 
5 requirement - limited in table 6 and 8 on the IEC60825-1. (3) Find total MPE(train) within the 
duration for which the concerned target(s) are exposed under the pulsed laser beam. (Average 
exposure in the train can not possess more energy that if it exists as a single pulse as). Since 
T = .002/200*2Pi = 1 .6Exp(-6) then F = Exp7, N = F (carrier, mod) * T(total) = 1.1 Exp8 *1 .6Exp 
(-6)= 176. Hence MPE (train) = MPEs N **(-0.25) = 3.3Exp(-6) * 176**(-.25) = 3.3 Exp(-6) * 

10 0.275 = 0.906 Exp (-6)J/sqcm. This is the maximum power limit for any pulse in the pulse train. 
Now compute the max transmitting peak power allowed: MPE(s)/A = Pt * Tp where Tp is the 
pulse width of the laser pulse series and Tp = Exp(-9)s, Pt (peak, max) = A*MPE(s)/Tp =0.0314 
sqcm*0.906Exp (-6) / Exp(-9) = 28.448 W (safety required). Therefore Pt (peak, max) = 
28.448W. According to items (1), (2) and (3) above, the infrared pulsed laser of the invention, 

15 featuring 9W peak power, 1.03-1.06um wavelength and 0.002rad transmitting angle, dual 
modulating and dual plane rotating, fully satisfies and complies with IEC 60825 product safety 
requirements. As the power specified above is for a 700 to 1050 nm laser beam, for higher 
ranges, the peak power permitted is larger. In considering both factors regarding system 
sensitivity and water media absorption, the wavelength range may be selected in the region 

20 from 1,000nm to 1 ,550 nm. The allocation of the wavelength may be based on a few factors, 
including the availability of the component resource. Generally, the region from about 1 ,300nm 
to 1 ,400nm may be excluded to avoid energy loss of the laser beam due to moisture absorption 
in its propagating path. The power requirements are summarized in Table 2. 


Power Type 

Scanning Laser Power 

System needs 

Adapted 
Design 

IEC 
60825 
Limit 

Minimum 
(basic) 
Requirement 

With Reserved 
Capacity 

(40dB 
Reserved) 

As high as 
what system 
requires 

Maximum 

Peak Value 

.104W 

10.4 W 

15W 

>28.45 W 

Average 
Value 

.52 mW 

52 mW 

75 mW 

>142mW 

Wave Main 
Properties 

Best Selected Wavelength: 1450 to 1550nm 

(IEC 60825 table under Corresponding Frequency 
Range) 

Repetition Rate: 10Mhzto 110Mhz (Exp7 Hz to 1.1Exp8 
Hz) 

Pulse Width: 1.0- 1.25 ns (constant) 


Table 2 Power Requirements 


[030] With reference to FIG. 3, a method generally designated 300 of avoiding a 

5 vehicle collision is shown including a step 310 of transmitting and receiving an infrared 
laser beam using the rotating pulsed infrared laser beam scanner apparatus 100 described 
herein. A reflected laser beam is filtered in a step 320 and processed in a step 330. 
Analog signal processing is achieved using application firmware. In a step 340 the 
processed analog signal is converted to a digital signal and processed by a digital 
10 processor in a step 350 and a co-processor in a step 360. An output signal from the digital 
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processor is amplified by a power amplifier in a step 370 and input to an electro-hydroid 
braking control in a step 380. An output signal from the digital processor is also input to a 
video interface in a step 390 and an output of the video interface is input to a display in a 
step 395. By operation of the method 300, a vehicle collision is avoided by applying a 
5 braking force to the vehicle in step 380 under conditions as further described herein. 

[031] FIG. 4 shows an analog circuit generally designated 400 for determining R, 

R'(t) and R"(t) corresponding to step 330. Using the circuit 400, R is taken at the output of 
op amp 430 (Vg), R'(t) is taken at the output of op amp 410 (Vd), and R"(t) is taken at the 
output of op amp 420 (Vf). 

10 [032] To avoid interference, a channel scrambler is provided. Each vehicle is 

allowed to transmit and receive its own channel separated by a channel band-width of 100 
kHz to avoid interference from signals produced by other vehicles using the system and 
method of the invention. A conventional channel dividing method may be employed to 
achieve this result as outlined in Table 3. One thousand channels may be used by 

15 following the following analysis. In US the total number of vehicles is assumed to be 50 
million and among these, 10 million use the system and method of the invention. Hence 
the maximum number of vehicles in an area subject to mutual interference is 1000. So the 
system c oncentration over t he t otal v ehicle population i n t he U S i s 1 /5 a nd t he c hannel 
concentration over the system is 1/1000. As the result, the channel concentration over the 

20 entire population of vehicles is 1/5 * 1/1000 or 1/5000. Then for a region having 1000 
vehicles, the number of these vehicles sharing the same channel is 500 * 1/5000 or 0.1 
vehicles. As two vehicles are required to cause a mutual disturbance, 2/0.1 or 20 is the 
safety factor. 


Channel 
Number 

N = 1,000 



Bank Width 

B = 100Khz = 
0.1 Mhz 

Filter Type 

Frequency 
Division 

Repetition 
Range*** 

F(L) = 10Mhz, 
F(H) = 110Mhz 

Resonant Q 
Value 

*** 


25 Table 3 Channel Scrambler Design 

[033] FIG. 5 shows an algorithm generally designated 500 implementable in the 

digital processor to achieve the purposes of the invention. In a step 510 Vf is computed as 
shown and t1 is recorded. In a step 520 Vr is recorded. Then in a step 530 when Vf is 

10 


equal to zero a timer is stopped and t2 recorded. In a step 540 Ts is determined as (t2 - 
t1). In a step 550 Q is determined as shown. Then in a step 555 Tc, the time to collision is 
determined as Tc = R/Vr. In a step 560 criteria are set as shown. Finally in a step 570 a 
determination is made if a collision will occur or not. 
5 [034] In order to determine the signal processing time, assume the scanner system 

has 200 revolution/s in the horizontal direction, and the laser beam sweeps over maximum 
(full condition) 3000 obstacle bodies during each revolution, that is 
NOB (max) = 200 Pi/.002 
= 3,000. 

10 Since detecting one obstacle body consumes 1 16ns, then the time needed to process data 


for one revolution is 

T (1 Rev.) = PTP(S) * NOB(max) (29) 

= 127 ns* 3000 (30) 

= .381 Exp6(ns) (31) 

15 = 381 (uS) (32) 

= 0.381 (ms) (33) 
The time necessary for processing data obtained within one second's scanning 

T (1s) = 0.381 ms* 200 (34) 

= 76.2ms (35) 

20 = 0.076 S (36) 


which means there is sufficient time to process all the data, or the data processing speed is 
fast enough to meet the system requirements. The operating times are summarized in 
Table 4. 

[035] The system overall properties are summarized in Table 5. 

25 
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Tabled 

Signal Process Algorithm & Operating Time 

(One "Obstacle Body") 



System 
Properties 

QTT Value 

System 
Properties 

1 QTT 

Value 

Remarks 

FIpMti 

cal 
Signal 
Proce 

ss 
time. 


<0.1ms 

Ranging 
Distance 
R 

R = 90 m 

S< 
1,017cmSq.. 
(Equivalent to: 
A circle with 
R = 18cm 
Or 

A standing 
pole with two 1 
inches width 
and 2meters 
height) 


Digital 

<1ms 


90m < R < 
120m 

S = 
1,017sqcm 


Total 

<1.1ms 


General 
R> 120m 

S = S0 
(R/R0r0.5 

Mechanical 
Response 
Required 

T m < 16 ms 

Shortest 
Detecting 
distance 

\ x>z m 

Remark: 
S stands for 
the area 


Detecting Plane 
Angle 

360° 

where the 
scanning laser 
beam strikes 
on while R0 = 

90m 
SO = 300sqcm 

Optical Signal 
Propagating 
Time 

I a < U.UUUb 

ms 

Impact 
Sustaining 
In Vertical Axis 

III ¥ 1 bi VWl # \/\lw 

10g* 

Obstacle 
Tracking Period 

Horizontal: 

21ms 
Longitudinal: 
126ms 

Humidity 

40%* 

Total Control 
Time 

Between 38 to 
143ms 

Detecting 
Height 

0.2 -1.6 m 



Table 5 System Overall Properties 

5 
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[036] What follows is a discussion of collision criteria. As shown in FIG. 

6, two vehicles (Vehicle A and vehicle B) are apart a distance r and travel in the 
direction with the speeds shown. For the convenience of analysis, we assume 
that both vehicles a re p laced i n an absolute angular co-ordinate system- the 
5 earth ground, and also the relative system with respect to Vehicle A as the 
original point of the relative system. Both systems use AC as the positive 
velocity direction and the clockwise direction as the positive angle and angular 
velocity direction. Vectors denoted with (') represent the relative system, 
whereas no (') denotes vectors in the absolute system. 
10 [037] Obviously, the projecting image component of relative angular 

velocity of Vehicle B along vehicle A's direction axis must be zero, otherwise it 
will not result in collision with Vehicle A, that is 

Vbt' Cos y = 0 (37) 
(in the relative system) 
15 While in the absolute system, it means 

Vbt Cos y = V (38) 
According to movement studies, 

Vbt = Va + Vbt' (39) 

From equation (37), we have either 
20 y = 90° (40) 

or 

Vbt' = 0. (41) 

[038] The condition where y = 90 0 is hard to detect, but to detect Vp" and 

25 determine that if then Vbt' = 0 is possible. From Equation (39), Vbt' = Vbt-Va. 
Based on Equation (41 ) and (39), Vbt' = Vpt - Va = 0 and thus Vbt =Va. 
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[039] If conditions 

Vbt = Va (42) 

and 

dR / dt = - K < 0, (43) 
5 are both true, said two vehicles will result in a collision, that is, it will take the 
same time - 1 seconds, for Vehicle A to move through segment AC, for vehicle B 
to move through BC, and for relative distance between Vehicle A and Vehicle B 
to become zero. In the mean time, all AC, BC and AB = r will be on the same tri- 
angle, upon applying equations (42) and (43). 

10 

[040] The mathematical statements below prove that if these two vehicles 

start from A and B points, after same time t, they move over distance AC and BC 
upon which AC, BC and r will be able to construct an exact triangle, in other 
words, they meet at the same time and the same location and a collision occurs. 
15 By inspecting triangle ABC, we have 

AC = Va* t (44) 

AB = d (45) 
The triangle hence should meet: 

BC = (Vat 2 + R 2 - 2 Vat*R* Cos9) 1 / 2 (46) 
20 but t = R/|dr/dt|= R/k (47) 

and Vb 2 = K 2 + Va 2 - 2Kva Cos6 (48) 
(where Vb stands for the absolute velocity of Vehicle B) 
That is 

Vb= ( K 2 +Va 2 - 2K Va Cos 0) 1 / 2 (49) 

25 

The time for vehicle B to travel to C will be 

T1 = BC/ Vb = (50) 
(Vat) 2 + R 2 -2 Vat*R* Cos6) 1 / 2 
(K 2 +Va 2 -2K Va Cos 9) 1 / 2 
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The time for the distance between Vehicle A and B to become zero should be, 
according to Vr = dr/dt 

T2 = R/|Vr| = R/K (51) 

Since when the time collision to occurs, 

5 T1 = T2 = t, hence R / K = 

(Vat 2 + R 2 -2Va*t* R * Cos 8) 1 / 2 

(K 2 +Va 2 -2K Va Cos 8) 1 / 2 

r 2 / K 2 = 

Va 2 *r 2 /K 2 + r 2 - 2 Va* r/K*r*Cos 8 
10 K 2 + Va 2 -2 KVaCosS 

Crossing multiplying both sides of this equation and then simplifying it to find that 
Left side = Right side 

= r 2 K 2 + r 2 va 2 - 2 Kr 2 Va Cos 8 
This means the equation is true. 

15 [041] That Vbf = 0 implies that 

R * cob' = Vbt - 0. Since R can not be zero requires that to has to be zero, 
thus we withdraw the criteria to determine if a collision between two vehicles' 
defined above should occur at: 

cob' = 0 (52) 

20 The relative angular velocity is zero or 

a = Ts * cose and 

dR/dt = Vr < 0 (53) 
And the condition when the braking action to be needed is: 

| Tr | < 1 . 5 (s) (54) 

25 [042] With reference to FIGS. 7 and 8 cob' is defined as the relative 

angular velocity, from Vehicle A to the dot pointed by the laser beam vector 
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striking on Vehicle B, turning around Vehicle A clock wisely, cob is defined as 
angular velocity, from Vehicle A to the dot pointed by the laser beam vector 
striking on Vehicle B, turning around Vehicle A clock wisely, case is defined as 
the angular velocity of the Infrared Laser Scanner, Vb is defined as the velocity of 

5 the scanned obstacle, Vs is defined as the line velocity of the scanning beam at 
the scanned point on the obstacle, A is defined as the diverging angle of the 
scanning inferred laser beam, Ls is defined as the length the beam vector 
sweeps over, and Ts is defined as the period for the entire laser beam pass over 
the extreme point, during which the changing rate of the relative distance 

10 maintains zero, mathematically expressed as "dR / dt = 0". 

[043] Let Vbp and Vsp stand for Vb's and Vs's projection along Va's 

direction line MN respectively. Then 


Ls =R * a 


(V bT + cose* R-Va Cosy) = R *a 


(55) 
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Since 


Cosy = Cos (90-(180- 6)) 


= Cos (-90+ 6)= Cos (90- 9) 


= Sin 9 


Hence equation (55) becomes 


20 


(V bt + cose R - Va Sin 9)Ts = R *a 


(56) 


and 


Vbt = R *al Ts- lose R + Va Sin 9. 


And because 


Vbt' = Vbt - Va Sin 9 It yields 


25 


Vbt' = R *aJ Ts- cose * R 


(57) 


cob' *R = Vb'R = Vbt' R 
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u)b'= VbtVR = (R *al Ts- wsc R) / R 

cub' = a / Ts- oosc (58) 

When cob' = 0 

a/ Ts- case = 0 

5 That is a/ Ts = oosc 

a = Ts * cose (59) 

[044] In order to determine the collision criteria coh must be computed. 

The value coh stands for the relative horizontal component of the angular velocity 
defined in equation (58), and it relates to the longitudinal component and the 
10 resultant component co T by 

co T 2 = coh 2 + coL 2 
which can be expressed as 

coh = (coT 2 - coL 2 )** 1 ' 2 (60) 

[045] Since the period Tl must ideally be greater than Th to avoid a 

15 permanent dead corner in the obstacle detecting process, as well as reducing the 
error caused by inducing coL in the calculations, we let 

TL = 10 Th. 

Because the longitudinal angle is tt/6, we have 
n/6 /coL = 10* 2 7i /coh. 

20 From this we obtain 

coh= 120 coL (61) 

[046] From equation. (60) and equation (61) we know that means coL is 

much smaller than coh and 

coL/coh = 0.008333 
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coh /coT = 1 / (1 + 0.00833 2 f 0 5 
= 1/ 1.0000347-1 

That is, cose ~ coh 

= a / Ts - cose 

5 cob' = a / Ts - coh (62) 

[047] In the real world, the algorithm for data processing to determine 

collision criteria may be more complicated - not all objects on the road will result 
in a collision, when the height of the object is low enough, it should be defined a 
"bumpy " instead of collision. In terms of the real road condition, since 

10 1.6 -R Sin ah < 1/3 Rw 

= .30/3 

= 0.10M 

where R is the distance to the obstacle and Rw is the radius of the vehicle's 
wheels, normally be 0.3m. The longitudinal angle denoted as 'a' is obtained by a 
15 specially design semiconductor a ngle detecting device, in which the measured 
longitudinal angle is in proportional to the illuminating passing through lights. 
Thai is, when 

R > 1.5 /Sin ah (63) 

will be judged as a collision case and be added as one of the collision criteria. 

20 [048] To predict the collision more accurately, the system of the invention 

may be non-linear, that is, the distance is the function of the longitudinal angle, 
and the relative velocity and relative angular velocity to the obstacle can be a 
second order variable, as described below. 

co = coO + (3 1 

25 R = R0 + V0 t + !4 a t **2 

where 0 is defined as 
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p = d(cob')/dt, where 
cob' = a / Ts- coh. 


as shown in equation (59) and 

T co is defined that after that duration the relative angle between two 
5 objects will become zero. 

[049] During the driving period, disregarding any traffic site (high way, 

freeway, s treets, I ocal p aths, p arking I og, ... etc.), b ased o n t he a ny measured 
data (with sampling rate 20Mhz), pnce the measured data R, Ts, as we as other 
computed data such as a, co, (3, Tr and T co , meet the equations listed below, a 
10 collision with a obstacle is concluded to occur within short time (1.5s) and the 
proper control must be taken to avoid a collision accident. 

[050] Since the data is continuously coming in and updated, the 

application of braking or the real situation modifies the criteria, the conclusion of 
the prediction about the collision may vary, hence the control action may persist, 

15 change (the strength of the braking, for instance) or cancel depending on the 
instantaneous computation result, but once braking starts, the control signal will 
be held for at least 250ms, waiting for the next reliable updated control signal. 
Note that all these operations are completed automatically without the driver's 
extra effort. Because the system keeps updating its control status every 250ms, 

20 the driver's participation will change the detecting result and the system will 
automatically count all these promptly in its analysis and control decision making. 

Tr = (( V0**2 - 2R0 * V't )**1/2 - V0))/a < 1 .5 s 

Tco = cob'/ (3 < 1.5 s 

[051] Any collision relates to a body, regardless of its material make-up, 

25 which can be metal, wood, cement, rock, plastics a human body... etc. In order 
to deal with the individual bodies, certain data are sampled in some critical points 
to determine the collision prediction. 
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[052] An obstacle body in the traffic environment can be a single body, 

such a 20cm diameter standing wire pole to support cables, a vehicle of a few 
meters in length, a body of a human being of 20 to 45cm width typically, or a 
building as wide as 4 to 100 meters. (If the data from any mass point on the 
5 body suggests a collision to occur, then we define that it is a collision.) To 
simplify the computation, we also assume reasonably that all points in the same 
body will have the same velocity, angular velocity, acceleration and their higher 
order derivatives. Thus, we can use these data to represent the entire body, for 
example, if information from these mass points does not suggest an immediate 
10 collision, then there is no collision control will be evoked. 

[053] Separating the individual bodies by 

dR/dt > Exp6 

where t = 1 1 @ dR/dt > 0 associates the starting edge of the body while t = t2 @ 
dR/dt < 0 associates the stopping edge of the obstacle body, since the length of 
15 the laser beam changes dramatically at these two points, while the within the 
same body usually not. If there is more than one time of 

V = dR/dt > + Exp6 

found consecutively, only the first one counts, while if there is more than one time 
of 

20 dR/dt < - Exp6 

found, the last one counts. All points found in this interval are regarded as one 
obstacle body. 

Remark: The obstacle body width D looks to the subject vehicle to be 
D~R*casc*(t2-t1) 

25 Ts = t2 -t1 
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[054] Start sampling by the period of 400ns (2.5Mhz) typically during the 
period between t1 and t2 mentioned above, so that 1.6us will sweep over an 
entire scanning angle. For each sampled data of "R" that associates with the 
body d enoted as Ri, the system h ardware a nd software will obtain, calculate 
5 and keep truck of the associated parameters, such as 

V = d Rc / dt, 

a = dV / dt , and 

da / dt = a' (t) 

ahi = f (Area being illuminated) 

10 An obstacle body will receive many times within one turn sweeping of the laser 
scanning, depending on the distance and its size. For example, at 90 meters 
away, a 18cm wide pole will receive about 16 points sampling if the repetition of 
the scanning laser wave is 10Mhz. Note that ahi is the look-down angle 
respecting to the horizontal direction and is obtained from a special device built in 

15 to the system that measures the angle through measuring the output power from 
a photo-sensitive semiconductor. 

[055] Determine the ai, dai/dt for all points in the obstacle body. 

Determine the ai, vi dai/dt in the critical point. When 

da/dt ~ 0 

20 it is the critical point because at this point the a, v reflect the true value of the 
obstacle body. As mentioned above, the data a, v, dv/dt obtained from the same 
body are also applicable to other points the entire body. Hence we can judge if 
one, some or all of these points should resulted in an immediate collision or not. 

If any one of these points within the body (does not necessarily have to be more 
25 than one) are predicted to resulted in a collision, then this obstacle body is 
predicted to result in a immediate collision. 
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[056] The five criteria below may be used in the circuit and algorithm to 

determine the possibility of collision for all points sampled from the "Obstacle 
Body" : 

cob' =Ts-1.6Exp(-1.6) 

5 Ri > 1.5/Sinahi (64) 

V = dRc/dt< 0 (65) 

(3 = d cob' / dt < 0 (66) 

T r i = (( V**2 - 2 (Ri - Rd) * a )**1/2 - V))/ V't 
<1.5 (67) 

10 To = cob' / p < 1.5 (68) 

Ri: m a: m/s 

p: radian/sqs Tri: s 

T co: s Rd: m 

where Rd is one half of the vehicle's diagonal, which varies with different types of 
15 vehicles (referring to the top view of the vehicle). A typical value for Rd is 2.25m. 
The reason to subtract Rd from Ri is that Ri, as a data obtained and computed 
from the system, originally refers to the distance between the center of the 
scanner to the target where the laser beam strikes in that particular sampling. 
Since the collision will occur between the nearest portion of two vehicles at the 
20 beginning of collision, not between the scanner and the obstacle target spot 
where the laser beam reaches, this conversion is necessary. One half of the 
diagonal is just an approximated model to simplify the computation. This way we 
exchange great convenience in the system's calculation with a small and 
acceptable error. The sub "c" denotes the critical point, where da/dt reaches its 
25 minimum. We a ssume t he value o f a '(t) falls into a n i nterval a s b elow a 1 1 his 
time, 

0.001 m/s**3 < a' (t) = d (da/dt) /dt < 0.1 m/s**3 
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[057] Note that the coh in equation (62) is replaced by cose, which stands 

for relative horizontal component of the angular velocity of the scanning laser 
beam defined in equation (62) and it relates to the longitudinal component and 
the resultant component coh by 

5 cobi' = a / Ts - cose 

[058] This set of five data is associated with one mass point in the body 

and if all of them meet the above equation set, this mass point will result in a 
collision, hence, this obstacle body is judged to result in an immediate collision. 

[0019] F in below stands for the applied force of vehicle braking while Fmax is the 
10 available maximum force used for braking, in the unit of "N". 

F= Fmax(1.5/T) (69) 

Were T is the time pending to collision, in the unit of "s". 
[059] To cope with a bumpy road 

F = K1*Fmax(h**K2) (70) 

15 0 <h <0.10 m 

0.05 < K1 < 5 

0.1 < K2 < 0.5 

where K1 and K2 are two constants and H is the height of the obstacle detected, 
in meters. 

20 Rf stands for the distance obtain 

[060] It should be understood, of course, that the foregoing relates to 

preferred embodiments of the invention and that modifications may be made 
without d eparting from the spirit and scope of the invention as set forth in the 
following claims. 
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